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ABSTRACT 

This paper presents kinematic equations for a six degree of freedom force-reflecting 
hand controller. The forward kinematics solution is developed and shown in simplified 
form. The Jacobian matrix, which uses terms from the forward kinematics solution, is de- 
rived. Both of these kinematic solutions require joint angle inputs. A calibration method is 
presented to determine the hand controller joint angles given the respective potentiometer 
readings. The kinematic relationship describing the mechanical coupling between the hand 
controller shoulder and elbow joints is given. 

The kinematic equations in this paper may be used in an algorithm to control the 
hand controller as a telerobotic system component. The purpose of the hand controller 
is two-fold: 1) Operator commands to the telerobotic system are entered using the hand 
controller; 2) Contact forces and moments from the task are reflected to the operator via 
the hand controller. 
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1 INTRODUCTION 


The force-reflecting Kraft Master * is built by Kraft Telerobotics, Inc. It is the master 
of an undersea master/slave teleoperator system. The “force-reflecting Kraft Master”is 
referred to hereafter as the “hand controller”. The hand controller has right- and left- 
handed versions for dual arm tasks. The Automation Technology Branch of NASA LaRC 
uses two such devices for force-reflecting hand controllers in telerobotic systems. 

An orthographic view of the right hand controller is shown in Fig. 1. This is an 
articulated six degree of freedom force-reflecting hand controller. There are six axes whose 
joint angles are determined from calibration of six potentiometers. For force reflection, 
torque commands are sent to the first five axes; the wrist roll is not driven. 

The hand controller is used to input motion commands into a telerobotic system. 
1 he force-reflecting capabilities of the hand controller are used to transmit task forces 
and moments to the operator. For each communication cycle, five torque commands are 
written to the hand controller; the controller responds with six potentiometer readings. 

The hand controller is used to command position or velocity to a manipulator. Either 
input mode requires the hand controller forward position transformation. The hand con- 
troller Jacobian matrix is used for reflection of task forces to the operator. These kinematic 
solutions are presented in this paper. 

The forward kinematics solution is given first. Following the conventions of Craig 
(1988), the Denavit-IIartenberg parameters are presented. The homogeneous transforma- 
tion matrices relating successive coordinate frames are obtained, based on the Denavit- 
IIartenberg parameters. The forward kinematics iolution is the concatenation of these 
matrices. 


* The mention herein of a trademark of a commercial product does not constitute any 
recommendation for use by the Government. 
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Rate input commands are generated with the difference of two forward position trans- 
formation matrices. A method is presented for determining the difference between two 
homogeneous transformation matrices. The kinematic relationship of the shoulder and 
elbow joint coupling is derived. A calibration method is developed to calculate the hand 
controller joint angles given the potentiometer readings. 

The Jacobian matrix of the hand controller with respect to the base frame is presented. 
It is used for reflection of task forces and moments. The Jacobian matrix also maps hand 
controller joint velocities into hand controller (artesian velocities. 

Examples are given to demonstrate calculations for the potentiometer/joint angle cal- 
ibration, forward position transformation matrix, and Jacobian matrix. 
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2 SYMBOLS 
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W 
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^23 
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RZ, RY, RX 
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r.j 

" F 

"[J] 
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Cartesian coordinate frame m 
Base coordinate frame 
Hand coordinate frame 
Kinematic base coordinate frame 
Wrist coordinate frame 
Denavit-Hartenberg parameters 
Potentiometer readings 
Joint angle variables 

$2 “f $3 

cosOi 

sinOi 

Homogeneous transformation matrix of {m} relative to {n} 
Rotation matrix of {m} relative to {n} 

Position vector from origin of {n} to {m} expressed in {n} 
Fixed hand controller lengths 
Factored kinema tics teTmi§ . 

Z-Y-X Euler angles ^ 

Angular velocity of {i} with respect to {y} expressed in {A;} 
Cartesian rates expressed in {m} 

Joint rates 
Joint torques 

Manipulator end-effector cartesian forces and moments 
expressed in {n} 

Jacobian matrix expressed in {^} 

Upper left partition of the Jacobian matrix 
Lower left partition of the Jacobian matrix 
Lower right partition of the Jacobian matrix 
Joint angle endpoints for calibration 
Potentiometer endpoints for calibration 
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3 FORWARD POSITION KINEMATICS 


3.1 Denavit-Hartenberg Parameters 

The kinematic diagram for the right hand controller is shown in Fig. 2. All joint angles 
are zero in Fig. 2. This is not a reachable position due to mechanical limits on the elbow 
joint. For the coordinate frame definitions in Fig. 2, the Denavit-Hartenberg parameters 
are given in Table I. The origins of coordinate frames {0}, {!}, and {2} are co-located at 
point A. The wrist frame origins { 4 }, { 5 }, and { 6 } are co-located at the intersection of the 
wrist yaw and pitch joints, point B. The origin of { 3 } is on the X 4 , Z 4 plane. The frame {77} 
is located at the hand controller grasp. For both velocity commands and force reflection, 
{6} is controlled with respect to {0}. Therefore, L {) and L b do not appear in the kinematic 
equations. 


'able ] 

Denavit-Harto 

nberg 

Parameters 

i 

a<_i 


di 

0, 

1 

0 

0 

0 

01 

2 

90° 

0 

0 

02 

3 

0 

L i 

L* 

03 

4 

-90° 

l 2 

l 4 

04 

5 

90° 

0 

0 

05 + 90° 

6 

90° 

0 

0 

0C 


Nominal values for the fixed lengths are L„ •= 203 , L 4 = 178 , L 2 = 203 , I 3 = 133 , L 4 = 84 , 
and Lr, = 114 (mm). 

3.2 Homogeneous Transformation Matrices 

The general homogeneous transformation matrix representing the position and orien- 
tation of {t} with respect to {» - 1} is given below (Craig, 1988). 

c8i —30, 0 a, 

rt-iyii sO^coci—i c8iCot{~ i aat,— i d^sot^-i , , 

* 1 sdisoti - 1 c0,sa, -i coti- j ' ' 

0 0 0 1 
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The Den av i t- 1 1 ar ten berg parameters or Table I are substituted into Eq. 1 to obtain six ho- 
mogeneous transformation matrices relating successive coordinate frames. These matrices 
are reported in Appendix A. 

3.3 Forward Position Transformation 

The forward kinematics position solution is a mapping from joint space to cartesian 
space. A homogeneous transformation matrix is used to represent the cartesian position 
and orientation. 

I I 

G*i i r/’c} f91 

— - - | \ l ) 

o o 0 I 1 . 

The unique forward kinematics solution is a concatenation of the homogeneous trans- 
formation matrices. 

[cTJ = |?T(^)] \\T{9 2 ) I \lT(e,)} - •Igr(tfc)] (3) 

Substituting the matrices of Appendix A into Eq. 3, the forward kinematics solution is: 

KaC G K A S g ^ K 2 C G K i: K F ' 

+ Kpc G - Kpsc H 4 Kp Ke 

K{)3q -1“ KqCq KOBO H 7\(>Cg K 0 

o 0 0 1. 

Common terms K t are fac tored out to reduce computation time. These terms, given 
in Appendix B, also appear in the Jacobian matrix, Eq. 17. 

The forward position transformation presented in this section is for the right hand 
controller. The kinematic diagram for the left hand controller is the same as the right, 
except the offset £3 is in the opposite direction. Only one Denavit-Hartenberg parameter 
from Table I is changed: d 3 = Therefore, the forward position transformation and 
Jacobian matrix for the left hand controller are also Eqs. 4 and 17. One change is required: 
is substituted for £3 in terms Ke and K F of Appendix B. 
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DIFFERENCE OF TW €> HOMOGENEOUS TRANSFORMATION MATRICES ! 


One possible hand controller algorithm requires the difference of two Jgrj matrices to 
form velocity commands and return-to-center force errors. The kinematic equations for this 
operation are presented in this section. The subtraction is not an algebraic subtraction. 

\d-,;T\ = (o'Tl - lo-T] (5) 

The translation and orientation decoupling of homogeneous transformation matrices is 
given in Eq. 2. The difference of two homogeneous transformation matrices is accomplished 
in two steps, translation and orientation. The translational difference is an algebraic 
subtraction. 

{ A Pd-< ; }={ A Po}~{ a Pc} ( 6 ) 

With a unity transformation of , { a Pd- <•} is the translational velocity vector error 
command. 

The rotational difference component is more complicated because there is no vector 
representation for orientation. A relative difference rotation matrix is used, relating the 
orientation of {!?} with respect to {C}. 

M = \U\ = \aR\ T (S*J (7) 

Three orientational difference numbers RZ, RY, RX are extracted from \%R\ using 
the (Z-Y-X) Euler convention (Craig, 1988). The following rotational velocity kinemat- 
ics transformation is required in order to obtain the angular velocity vector command, 
expressed in {( 7 }. Equation 8 is adapted from Appendix II of Kane, et. al. (1983). 

= + {M 

' ( a CId-,;)y — [&z\cy s x + {&y}cx ( 8 ) 

'' { A £Id-<:)z — {0Z fCyCx ~ {^r}sx 

The following assumptions are made for use in Eq. 8. 

*x = Ry} = RX 

6y = {6y} = RY ( 9 ) 

e z = {o z } = rz 
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Equation 10 transforms the angular velocity vector command into {/!} coordinates. 


A ( A n 0 -a) = $R\ G t A ti D -o) 


(10) 


5 ELBOW JOINT KTNFdUATTCS 


The shoulder pitch joint and elbow pitch joint potentiometers and motors are mounted 
on the link driven by the shoulder yaw joint. The kinematics of the coupling between the 
shoulder and elbow pitch joints must be determined. This mechanical coupling is a four 
bar linkage, as shown in Fig. 3. 

The four bar linkage coupling does not remove one of the six hand controller degrees of 
freedom. In Fig. 3, links 1 and 2 rotate independently. If either link 1 or 2 were fixed, or if 
their motion was not independent, the hand controller would have five degrees of freedom. 
The following presents the relationships between the second and third potentiometers and 
joint angles. 

The four bar linkage with the Denavit-Hartenberg joint angles is shown in Fig. 4. 
The second potentiometer measures 9 2 , which orients link r 2 . The four bar linkage is a 
parallelogram with n - r 3 32 mm and r 2 — r 4 ■= 180 mm. The third potentiometer reads the 
angle which orients link r L . In the parallelogram four bar linkage, links r t and r 3 always 
have the same orientation angle. The third potentiometer reads (0 2 + 0 3 ), as shown in Fig. 
4. 
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6 rOTENTIQMETER/JOINT ANGLE CALIBRATION 


This section details the mapping from potentiometer readings to joint angles for the 
right and left hand controllers. The potentiometers are linear with nominal range 0 to 
4095 counts following A/D conversion. Due to angular limits, none of the potentiometers 
cover the full range. The calibration of the right and left hand controllers is not identical. 
The calibration is required to calculate the Denavit-Hartenberg joint angles for the forward 
position transformation and the Jacobian matrix. The method presented in this section is 
general, but the potentimeter data in Tables IV and V and the calibration equations, Eqs. 
12 and 13, are specific to the hand controllers operated by the Automation Technology 
Branch of NASA LaRC. 

The nominal values for angular limits are given in Table II. 


Table II; Nominal Angular Limits 


i 

On 

&i2 

i 

-90° 

90° 

2 

0° 

to 

o 

o 

3 

-135° 

-35° 

3 

135° 

'85° 

4 

— 55° 

55° 

5 

D 

o 

50° 

6 

-45° 

45° 


There arc two ranges given for i = 3 in Table II. The first corresponds to 9 2 = 0° and 
the second to 9 2 = 120°. The elbow angle has a minimum travel of 50° when 9 2 = 120° 
and a maximum travel of 100° when 9 2 = 0°, due to the mechanical coupling discussed in 
the previous section. 

Table III shows the correspondence among the potentiometers, joint angles, and joint 
names. The third potentiometer POT 3 directly measures 9 2 \- 6 3 . Note that POT 4 and POT b 
are reversed with respect to joint angle index. 
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Ta ble III: Potentiometer /Joint Angle Correspondenc e 


Potentiometer 

Joint Angle 

Joint Name 

POT i 

9 1 

Shoulder Yaw 

pot 2 

*2 

Shoulder Pitch 

pot 3 

02 H 03 

Elbow Pitch 

pon 

04 

Wrist Yaw 

pot 4 

05 

Wrist Pitch 

POT , b 

0G 

Wrist Roll 


The relationship between each potentiometer and the corresponding joint angle is 
linear. The calibration is accomplished by writing this linear equation between the two 
angular limits for each joint. The calibration for a general joint is shown in Fig. 5. The two 
endpoints are ordered pairs of potentiometer count and joint angle, denoted as ( POT 9 ia ) 
and (POT,i,, 0 ih ). The general linear calibration equation is given below, where the variables 
are ( POT it 9,). 

Table IV gives the measured values for each joint of the right hand controller and 
Table V the left. For the elbow joint there are two different limit ranges, depending on the 
value of 9 2 . The two extreme endpoints are used for the POT 3 equation. The positive joint 
angle convention does not necessarily match a positive change in potentiometer counts. 


Table TV: Calibration Data for Right Hand Controller 


Potentiometer Index 

POT in 

POT ih 

9, a 

0*h 

1 

157 

4014 

90° 

-90° 

2 

751 

3328 

0° 

120° 

3 

248 

3863 

35° 

-135° 

5 

500 

2930 

55° 

-55° 

4 

1126 

2766 

O 

O 

1 

Cn 

O 

o 

6 

1395 

2656 

45° 

-45° 
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Table V: Calibration Data for Left Hand Controller 


Potentiometer Index 


1 

2 

3 

5 

4 

6 


POT t , 


119 

777 

240 

808 

1228 

1402 


POT ih 


3983 

3354 

3859 

3280 

2856 

2634 


90° 

0 ° 

35° 

55° 

- 20 ° 

45° 


<'il, 


-90° 

120 ° 

-135° 

-55° 

50° 

-45° 


The calibration equations are obtained by evaluating Eq. 11 with the data of Tables 

IV and V. The results are expressed in radians. Equation 12 is for the right hand controller 
and Eq. 13 is for the left. 


$t = 1.699 - 8.145xlO' 4 FOr, 

0 2 = -0.610 + 8. 127x 10~ 4 POT? 
h + 03 = 0.814 - 8.208xl0" 4 POr 3 

&4 - 1.355 - 7.901x10 ~*POT b ^ 

0 b = -1.188 + 7.450X t0~ 4 PO7 , 4 
0c = 2.523- 12.457xlO“ 4 POT c 

0i = 1.668 - 8. 130x10" 4 POTt 
01 = -0.631 + 8.127x 10 ~*POTi 
0i + 0c = 0.808 - 8. 198 x 10" 4 POT 3 

04 = 1.587 - 7.766x10 4 POT b ( 13 ) 

06 = -1.271 + 7.504x 10" 4 PO7’ 4 
0 C = 2.573 - 12.750x1 0" 4 PO7 , e 

Due to the sensitivity of the potentiometers and the uncertainty in joint angle mea- 
surements, an improved calibration method would read several (POT;, 0.) combinations for 
each joint and then obtain a linear least-squares fit. Upon implementation, the results of 

Eqs. 12 and 13 were judged to be sufficiently accurate, and thus the improved method was 
not pursued. 

From inspection of Eqs. 4 and 17 and Appendix B, neither the forward position 
transformation nor the Jacobian matrix require 0 3 explicitly. The sum 0 2 + 0 5 is required 
and available directly from the calibration equation for POT 3 . 
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7 JACOBIAN MATRIX 


The Jacobian matrix is a linear operator which maps joint space velocities to cartesian 
velocities. The Jacobian matrix order is six by six for the hand controller. 

= (14) 

The transpose of the Jacobian matrix translorms cartesian forces and moments to joint 
torques. 

tj = m [J] T "‘{F} (15) 

The vector of cartesian forces and moments at the manipulator end-effector is m {F). 
Hand controller joint torques r.j reflect m {F) to the operator at the hand controller wrist. 
The Jacobian matrix and the cartesian force/moment vector are expressed in frame {m}. 
The Jacobian matrix with respect to {0} requires fewer calculations than with respect to 
{6} and so m = 0 is used. 


VI = 


m J n 

j, 12 

^13 

0 

0 

0 

J 2 i 

J 22 

J23 

0 

0 

0 

0 

^32 

*^33 

0 

0 

0 

0 

J42 

J 43 

J44 

^4b 

J 4 G 

0 

J $2 

^53 

Jb4 


JbG 

. 1 

0 

0 

^G 4 

Jg b 

^CG 


(16) 


The upper right three by three submatrix of the Jacobian is the zero matrix because 


the wrist frames {4} through {6} share a common origin 

\Jvl\ I M 

VI- --- I --- 

. [Jll\ I [Jl.il I 


I Jo l1 = 

[Ji.i/1 - 
[Ji.il] - 


—Ke —Kqci — K7C1 

Kp —K$$ i —KfSi 

0 K jo Ks 

0 si si 

0 —ci —ci 

1 0 0 

— Cl 323 : 

“3iS 2 3 k 4 k d 

C23 Jf() A5 


(17) 

(17a) 

(176) 

(17c) 


The kinematic terms for the Jacobian malrix, also used in the forward position trans- 
formation (Eq. 4), are given in Appendix B. 
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8 EXAMPLES 


Two examples of the potentiometer/joint angle calibration, forward position trans- 
formation matrix and the Jacobian matrix for the right hand controller are given in this 
section. The input is the vector of potentiometer counts, POT lt . . . , POT c . Output is {0}, 
fe’T], and "[JJ using Eqs. 12, 4, and 17, respectively. The examples use the nominal values 
for Li,L 2 ,L 3 , and L 4 given in Section 3.1. 

The position of Example 1 is shown in Fig. 1. This is a good default initial position. 

1) {POT}= {2086,2683,992, 1595, 1715, 2025} r 


{0} = {0.0,90.0, - 90.0, 0.0, 0.0, 0.0} r 

■0.000 0.000 1.000 203.000 ' 

0.000 -1.000 0.000 -133.000 

1.000 0.000 0.000 262.000 

.0 0 0 1 


■133.000 

-262.000 

-84.000 

0.000 

0.000 

0.000* 

203.000 

0.000 

0.000 

0.000 

0.000 

0.000 

0.000 

203.000 

203.000 

0.000 

0.000 

0.000 

0.000 

0.000 

0.000 

0.000 

0.000 

1.000 

0.000 

- 1.000 

- 1.000 

0.000 

- 1.000 

0.000 

. 1.000 

0.000 

0.000 

1.000 

0.000 

0 . 000 . 


Example 2 is a general position. 

2) {POT} = {2622, 1610, 2268, 1829, 2488, 1745} r 


{0} = { — 25.0, 40.0, — 100.0, —35.0, 10.0,20.0} T 


m - 

- 0.498 
-0.438 
0.748 
. 0 

-0.826 

-0.502 

0.256 

0 

0.263 

-0.746 

-0.H12 

0 

225.293 * 
-251.805 
-19.387 
1 


-251.805 

17.571 

121.267 

0.000 

0.000 

0.000 * 

225.293 

-8.193 

-56.548 

0.000 

0.000 

0.000 

0.000 

310.602 

174.246 

0.000 

0.000 

0.000 

0.000 

-0.423 

-0.423 

0.785 

-0.606 

0.263 

0.000 

-0.906 

-0.906 

-0.366 

-0.621 

-0.746 

. 1.000 

0.000 

0.000 

0.500 

0.497 

-0.612. 
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9 CONCLUSION 


This paper presents kinematic equations for control of a six degree of freedom force- 
reflecting hand controller. The hand controller is used for commanding motion and reflect- 
ing forces in a telerobotic system. The forward kinematics solution and Jacobian matrix 
are derived for control of the hand controller wrist with respect to the base. A method 
is given for finding the difference between two homogeneous transformation matrices to 
form velocity commands and return-to-center force for the hand controller. The mechan- 
ical coupling between the shoulder and elbow pitch joints is investigated. A calibration 
method is presented to calculate the hand controller joint angles given the potentiometer 
readings. Numerical examples are given for the equations. This paper gives the kinematic 
equations required for control of this force-reflecting hand controller. 
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Six homogeneous transformation matrices are given in this appendix, relating frame 
{*} to {» 1 } for the hand controller, where i = 1 , 2 ,..., 6 . These matrices are obtained by 

substituting the Denavit-Hartenberg parameters of Table I into Eq. 1. 


\IT\ = 


l^) = 


I %T] = 


0 0 

-1 0 

0 0 


0 h 
0 0 

1 l 3 
0 1 


0 0 
0 1 

0 0 

- 1 0 

n o 

0 1 

0 0 * 

-1 0 
0 0 

0 1 . 
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APFENDIX B: FACTORED KINEMATICS TERMS 


The common kinematic terms for the forward position transformation, Eq. 4, and the 
Jacobian matrix, Eq. 17, are given below. 

K{) ~ 32334 

Ki = C1C23 
Kj = 3iC 2 3 
K tn = 523^6 
K n ~ 523^5 

K ! =3x34 - KiC4 
K 2 — 3 x C 4 4 S 4 
#3 = -C 1 S 4 - KjC 4 

K 4 = — CXC 4 4" /fj'34 
#5 ~ C 23 S 5 h l^rnC4 
f^6 = " l^n c 4 

K-J — Z/2^23 +■ 1^4 C 23 

1^8 = «^2 C 23 “ f>4 5 23 

jKo = Kf + fji S 2 

#10 = #8 + ^l c 2 

= Kis$ - K m ci 

Kd ~ -^3^6 “ K rt i 3 1 
K ( j = —Kic?, — K n ci 
Kd = -K 3 c:. - K n s x 

/T /3 = K w si — L3C1 
Kjr ~ KnyC 1 4 ^3^1 
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Figure 1 

Right Kraft Master 
Orthographic View 
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